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A  THEORETICAL  CONTROL  STUDY  OF  THE 
BIOLOGICALLY  INSPIRED  MANEUVERING  OF  A  SMALL  VEHICLE 
UNDER  A  FREE  SURFACE  WAVE 


INTRODUCTION 

Biologically  inspired  maneuvering  of  man-made  vehicles  has  the  potential  of 
being  of  value  to  the  Navy.  Aquatic  animals  have  the  ability  to  perform  intricate 
maneuvers  with  great  agility  and,  at  the  same  time,  very  quietly.  Fish,  for  example,  have 
several  configurations  of  fins  including  the  dorsal  and  caudal  fins.  These  fins  provide  a 
remarkable  ability  to  fish  for  swift  and  complex  maneuvers  (Wu  et  al.'  and  Azuma^). 
Apparently,  biologically-inspired  dorsal  and  caudal  fin-like  control  surfaces  have  a  great 
potential  for  maneuvering  small  agile  vehicles  at  low  speed.  However,  application  of 
these  control  surfaces  to  small  undersea  vehicles  for  quiet  but  agile  maneuvering  has 
remained  unexplored. 

Presently  at  the  Naval  Undersea  Warfare  Center  (NUWC)  Division,  Newport,  RI, 
considerable  effort  is  in  progress  to  study  fish  morphology  and  locomotion 
(Bandyopadhyay,^  Bandyopadhyay  and  Donnelly,'*  and  Bandyopadhyay  et  al.^). 
Experimental  results  conducted  using  several  species  of  fish  have  provided  interesting 
data  for  the  design  of  control  surfaces  for  low-speed  maneuvering.  Bandyopadhyay  and 
co-researchers  have  designed  caudal-  and  dorsal-like  fins  and  studied  the  hydrodynamics 
of  oscillating  and  cambering  fins.  The  flow  pattern  and  vortices  formed  have  been 
recorded  (Bandyopadhyay  et  al.®)  in  tests  performed  in  tow  tanks  and  water  tunnels,  and 
the  forces  and  moments  produced  by  the  control  surfaces  have  been  measured.  Related 
research  to  produce  propulsive  and  lifting  forces  using  flapping  foil  devices  has  been 
conducted  by  several  authors.’"'^  However,  as  yet,  control  systems  synthesis  using  caudal 
and  dorsal  fins  has  not  been  accomplished. 

The  contribution  of  the  present  research  lies  in  the  design  of  control  systems  for 
low-speed  maneuvering  of  small  undersea  vehicles  using  dorsal-  and  caudal-like  fins 
(figure  1).  It  is  assumed  that  the  hydrodynamic  parameters  of  the  vehicle  are  imprecisely 
known  and  surface  wave-induced  forces  are  constantly  acting  on  the  vehicle.  Although 
the  design  approach  can  be  extended  to  yaw  control,  in  this  study,  only  control  in  the  dive 
plane  is  considered.  Using  the  dorsal  fin,  a  normal  force  is  produced  for  depth  control 
and  flapping  foils  produce  pitching  moment  for  pitch  angle  regulation.  For  simplicity,  it 
is  assumed  that  the  vehicle  is  equipped  with  a  control  mechanism  that  causes  the  vehicle 
to  move  forward  with  a  uniform  velocity.  For  the  depth  trajectory  control,  an  adaptive 
sliding  mode  control  law  (Slotine  and  Li,'^  Utkin,''*  Narendra  and  Annaswamy'®)  is 
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designed  for  the  continuous  cambering  of  the  dorsal  fms  in  the  presence  of  seawaves. 
The  sliding  mode  control  law  is  nonlinear  and  discontinuous  in  the  state  space  and  has 
excellent  insensitivity  property  with  respect  to  disturbances  and  parameter  variations. 


WAVE  PROPAGATION 


> 


where: 

Xf  -Zj-  Inertia!  Coordinate  System  (Origin  at  the  Calm  Surface). 

9  $ 

Xj  -  Zj  =  Translation  of  Inertial  Frame  (Origin  at  Geometrical  Center). 
Xb-Zb  =  Body  Fixed  Coordinate  System. 


(Note  that  the  long  dorsal  fins  are  actually  mounted  in  the  horizontal  plane.  The  caudal  fins  are 
also  mounted  in  the  horizontal  plane  and  are  akin  to  flukes  in  whales.) 

Figure  1.  Schematic  of  the  Maneuvering  Devices  (Dorsal  and  Caudal  Fins) 

and  Axisymmetric  Cylinder 


an 
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The  hydrodynamics  of  flapping  foils  is  rather  complex.  Although  design  based  on 
the  continuous  control  of  the  angular  velocity  of  the  fins  is  more  efficient,  forces  and 
moments  produced  by  the  caudal-like  fins  as  functions  of  angular  position  and  velocity  is 
not  well-understood.  This  study  is  limited  to  a  periodic  (sinusoidal)  actuation  of  flapping 
foils.  It  is  assumed  that  the  foils  have  identical  periods  of  oscillation  that  do  not 
necessarily  coincide  with  the  period  of  the  seawave.  The  amplitude  and  phase  of  force 
and  moment  acting  on  the  vehicle  caused  by  the  disturbing  wave  is  assumed  to  be 
unknown.  Assuming  that  the  pitch  angle  deviation  is  small,  a  linear  discrete  adaptive 
predictive  control  system  (Goodwin  and  Sin^^)  is  designed  for  the  pitch  angle  control.  In 
order  to  develop  periodic  moment,  the  maximum  travel  of  the  tips  of  the  foils  is  adjusted 
periodically  at  the  completion  of  the  cycle.  Interestingly,  for  the  design  of  the  pitch 
controller,  it  is  seen  that  Strouhal  numbers,  which  characterize  the  moment  produced  by 
the  foils,  are  key  control  variables.  In  the  closed-loop  system  using  the  dorsal  and  caudal 
fin  controllers,  depth  control  and  pitch  angle  regulation  in  the  dive  plane  are 
accomplished. 


MATHEMATICAL  MODEL  OF  DIVE  PLANE  MOTION 

Consider  the  vehicle  motion  in  the  dive  (vertical)  plane  (figure  1).  The  heave  and 
pitch  equations  of  motion  are  described  by  coupled  nonlinear  differential  equations.  In  a 
moving  coordinate  frame  fixed  at  the  vehicle’s  geometrical  center,  the  dimensionless 
equations  of  motion  for  a  neutrally  buoyant  vehicle  are  given  by'’*’^ 

r?{w  -uq-  ZQq^  -  XQq)  =  z^q  +  z^w  +  z^q  +  z^w 

nose 

-Cf)  J  Kx)( w  -  xq)\w  -  xqldx  -l-  z^d  +  fp+fd, 

tail 

Iyq  +  mzQ{u  +  wq)-rnxQ{w-uq)=  M^q+  M^w+  M^q  (1) 


+M^w  +  Cp)  I  xKx)(w  -  xq)\w  -  xq\dx 


tail 


-XQgW  cos  Q  -  zqqW  sinB  +  nip  +  , 


where  S  =  q,  z  =  -us\n9  +  wcos^,  Xq^  =Xq  -  Xg,  zgg  =Zq  -  zg,  ^is  the  camber  of 
the  dorsal  fins,  +mp2,  is  the  moment  produced  by  the  ith  foil,  is  the  net 

normal  force  produced  by  the  flapping  foils,  and  and are  the  force  and  moment 
acting  on  the  vehicle  caused  by  the  surface  wave.  Here  it  is  assumed  that  the  forward 
speed  is  held  steady  (u=  U)  by  a  control  mechanism.  These  nondimensionalized 
equations  of  motion  (equation  (1))  are  obtained  by  dividing  the  original  force  and 
moment  equations  by  ^  pI?V^  and  j  pI?V^  where  L  and  V  =  U  aie  the  reference  values 
for  length  and  velocity,  and  the  time  is  scaled  by  (U/L).  Thus  z^,fp,  and  are  the 
hydrodynamic  coefficients  of  the  vertical  force  and  the  pitching  moment. 
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^=(6.  q,z,w)T 


TARGET 

DEPTH 

Z*  . 


where  Z*  =  Target  Depth, 

0  =  Pitch  Angle, 

0*  =  Equilibrium  Pitch  Angle, 

S,i,  =  Strouhal  Numbers  of  Foils, 

A,,  A2  =  Maximum  Travel  of  Foils, 

6  =  Camber  of  Dorsal  Fins. 

Figure  2.  Closed-Loop  System  (Including  the  Caudal  and  Dorsal  Fin  Controllers) 


Bandyopadhyay  et  al.^°  have  experimentally  measured  the  forces  and  moments 
acting  on  winged  bodies  submerged  in  proximity  of  surface  waves.  The  disturbance  force 
and  moment  caused  by  surface  waves  are  periodic,  which  can  be  expressed  by  a  Fourier 
series.  For  simplicity  in  presentation,  consider  that  fd  and  are  well  approximated  by 

their  fundamental  components  and  are  given  by 

fd  =  Fd  cos{o}J  +  a^) 
ntd  =  Md  cos[o)j  +  a 
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where  is  the  fundamental  frequency  of  the  surface  wave,  Fj  and  Md  are  amplitudes, 
and  is  the  phase  angle. 

The  dorsal  fm  produces  a  normal  force  proportional  to  the  camber  5  of  the 
fins  and  can  be  continuously  varied  for  the  purpose  of  control.  The  forces  and  moments 
produced  by  the  flapping  foils  are  quite  complex  and  depend  on  motion  pattern  (clapping 
and  waving)  as  well  as  on  the  frequency  of  oscillation,  maximum  flapping  angles,  axis 
about  foils  oscillate,  and  the  speed  U.  The  choice  of  flapping  parameters  and  the  mode  of 
oscillation  can  produce  a  variety  of  control  forces  and  moments.  Based  on  the 
experimental  results  and  analysis,  it  had  been  shown  by  Bandyopadhyay  and 
coworkers^  '*’^  that  flapping  foils  produce  periodic  forces  whose  period  is  equal  to  the 
period  of  flapping.  Therefore,  their  periodic  forces  can  be  expressed  by  a  Fourier  series, 
but  are  dominated  by  their  fundamental  components.  Although  the  approach  of  this  report 
can  be  generalized,  for  simplicity,  it  is  assumed  that  the  flapping  foils  produce  forces  and 
moments  of  the  form 


fp=  -^10  ®  /  )  +  -^20  (‘^?2 » ®  / )  +  -^1 1  ,C0  y]cOs(cOy^/  +  ai) 

+  F,2(S, 2, CO^)  cos(coy- t  +  a2) 

(3) 

trip  =  f)+  M2o{s  12,(0 f)+  f)cos{o)j- 1  +  ai) 

+  Mi2{tf2,(0  y-)cOs(o)y-t  +  a2), 


where  Sfi  is  the  Strouhal  number  defined  as 


s„  =  ,  /  =  1,2  (4) 

and  is  a  dimensionless  angular  firequency  parameter,  is  the  frequency  of  oscillation, 
and  is  the  maximum  cross-stream  travel  of  the  flap  tip.  It  is  important  to  note  that  the 
Strouhal  number  of  each  foil  is  a  key  control  variable  that  can  be  altered  by  the  choice  of 
frequency  and  the  tip  travel  independently,  and,  thus,  one  can  control  the  contribution 
of  each  foil  in  force  generation  for  the  purpose  of  control.  Indeed,  as  shown  by 
Bandyopadhyay,^  by  an  analysis  of  a  simplified  two-dimensional  momentum  model, 
lateral  steady  forces  produced  by  the  two  foils  in  clapping  mode  are 

^io(^n./i)  =  sin(4./2),  (5) 


and 


(6) 
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where  for  the  zth  flap,y/,  is  the  frequency  of  oscillation,  rrij  is  the  mass  of  water  it  affects, 
and  Uj  is  the  velocity  of  water  caused  by  the  flapping  action  at  an  angle  of  tan“*  (2^)  to 
the  axial  direction  where  Ch  is  the  chord.  Thus,  for  5^,  =  Sp_  and  =  ^2,  .^lo  +  -^20  =  Mo 
+  Mjd  =  0  and  by  flapping,  one  produces  pure  sinusoidal  forces  of  amplitudes  M,,  and 
M22,  and  if  S',,  ^  8^2,  flapping  action  yields  nonzero  (positive  or  negative)  constant  force 
component  TJo(5,i,/i)+  ^20(5,2,72)  ,  as  well  as  a  time-varying  periodic  component. 

For  the  purpose  of  control,  in  this  study,  it  is  assumed  that  the  two  foils  are 
controlled  independently  and  oscillate  with  the  same  frequency  but  the  maximum 
travel  of  each  tip  is  varied  at  the  interval  of  ,  the  time  period  of  oscillation  of  foils. 

A  continuous  change  of  and  A2  is  not  allowed  here  since  the  intention  is  to  develop  a 
periodic  force  by  flapping,  although  such  an  imposed  mode  of  oscillation  does  create  a 
complex  control  design  problem.  Note  that  we  are  trying  to  imitate  biolocomotion  for 
slow  speed  maneuvers. 

The  problem  of  interest  here  is  to  design  a  control  system  for  the  independent 
control  of  depth  (z)  using  dorsal  fins  and  stabilize  the  pitch  angle  dynamics  using 
flapping  foils.  This  decomposition  of  the  dive  plane  control  problem  simplifies  the 
controller  design.  An  adaptive  sliding  mode  control  system  is  designed  for  large 
magnitude  depth  (z)  control  using  only  translatory  dynamics,  and  a  discrete  adaptive 
predictive  controller  is  designed  for  pitch  angle  regulation  separately  based  on  the 
decoupled  rotational  dynamics  of  the  pitch  angle  of  the  vehicle.  A  judicious  choice  of 
controller  design  is  essential  since  the  dorsal  fins  are  continuously  cambered,  the 
parameters  of  oscillations  of  the  foils  can  be  altered  only  at  the  completion  of  the  cycle  of 
flapping  at  discrete,  but  uniformly  distributed,  instants  of  time. 

The  system  (equation  (1))  can  be  written  in  a  vector  form  as 

f 

VI 

or 

i^A(^,d„d2)  +  BU,,  (8) 

where  =  eR^  is  the  state  vector  (T denotes  transposition), 

=  ((J,  fp,mp^  is  the  control  vector, 

B  =  (Bij), 


10  +  VVCOS0 

32^  +  <33  (^Gfi  cos  0  +  Zg5  sin  0)  ■ 
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t  =  -  M/^)- (mxg  +  )(mxc  +  A/*), 

■^21  =  •^5^22 
B2i={mxQ+z^)i^\ 

B22={M^  +  mxQ)^~\ 

-^31  =  -^32^5’ 

^33  =(m-z^)A"’, 

ai  =  [{ly  -  Mg)z^  +  +  z^)MwY~\ 

ai  =  [(^>-  -  ^q)[^  +  ^q)  +  ^9^ 

^3  =-(mxQ  +Zq)wix^, 

fl4  =  [(z^,  -  M^)4  +(»7Xg  +4)4  +(4  -  Mq)mzGq^  -  (mxG  +  z^)mzQwqY-\ 

=  [{m  -  z^)M^  +  {mxG  +  M^)z^]^~\ 
a^=[{m-z^\Mq-mxQ)  +  {mxQ  +  )[m  +  z^  )]  A"* , 

a2=-{m-z^)Wtx\ 

=  [(m  -  z^ )4  +  {mxQ  +  M^)l^  -{m-z^  )mzGwq  +  {rwcg  +  M^)mzQq^]A~^ , 

=  [(4  -  M^)fa  +  (mxc  +  z^)m^]A-\ 
dl  =  [{m-z^)m^  +  {mxQ  +  M^)4]A"\ 

and  4,  Iq  are  the  cross-flow  integrals  where 

nose 

J  bix){w  -  xq)\w  -  xq\dx , 

tail 

and  (10) 

nose 

Iq=Cj)  j  xKx)(w  -  xq)\w  -  xq\dx . 


The  matrices  A  and  B  are  obtained  by  comparing  equations  (7)  and  (8). 

For  equation  (8),  we  are  interested  in  designing  a  dorsal  fin  control  system  for  the 
depth  control  and  a  caudal  fin  control  system  for  the  pitch  angle  regulation.  For  the 
derivation  of  the  control  system,  it  is  assumed  that  various  hydrodynamic  parameters  and 
the  amplitudes  and  phases  of  the  force  and  moment  induced  by  the  surface  wave  are 
unknown. 
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DORSAL  FIN  CONTROL  SYSTEM 


In  this  section,  a  dorsal  fin  control  system  is  designed  for  depth  control.  Since 
depth  (z)  control  is  of  interest,  an  output  controlled  variable 

yo  (11) 

is  associated  with  the  system  (equation  (8)).  Consider  a  reference  trajectory, 
generated  by  a  second  order  command  generator 

yr  +  24-  Xr  +  >  (12) 

where  z*  is  the  target  depth  coordinate,  >  0,  and  >  0.  The  parameters  and  are 
properly  chosen  to  obtain  the  desired  command  trajectories.  The  objective  is  to  steer  the 
vehicle  using  the  dorsal  fins  so  thaty^  =  z(t)  asymptomatically  follows  Asy^  tends 
to  yriOi  Ills  vehicle  attains  the  desired  depth  since  y^  converges  to  z*. 

For  the  derivation  of  a  controller,  an  adaptive  sliding  mode  control  technique 
is  used  and  the  sliding  surface  is  defined  as 

S  =  e  +  Ae,  (13) 

where  Ji>0  and  e  =  (y^  -y^)  =  ^  -  yr  is  the  tracking  error.  The  sliding  mode  control  law 
is  a  discontinuous  function  and  svidtches  whenever  the  trajectory  crosses  the  surface  S  = 
0.  In  using  a  sliding  mode  control  law,  the  evolution  of  trajectory  proceeds  in  two  phases. 
In  the  first  phase,  which  is  called  the  reaching  phase,  trajectory  starting  from  any  initial 
condition  is  attracted  toward  the  svwtching  surface.  The  subsequent  motion  takes  place 
on  the  surface  S  =  0  and  the  trajectory  essentially  slides  along  the  switching  sinface.  This 
is  the  second  phase  of  motion  called  the  sliding  phase. 

Consider  the  motion  during  the  sliding  phase.  During  the  period  of  sliding,  one 
has  S(t)  =  0 ,  which  implies  from  equation  (13)  that 


e  +  Ae  =  0. 


(14) 


Thus,  during  the  sliding  phase 

e(r)  =  e^('-'^)e(rj,  (15) 

where  4  is  the  instant  when  the  trajectory  has  reached  the  surface  S  =  0.  According  to 
equation  (15),  it  follows  that  e(0  ->■  0,  that  is,  z(t)  ^  z*  as  /  ^  00  and  the  desired  depth 
control  is  accomplished.  Obviously,  the  motion  during  the  sliding  phase  is  insensitive  to 
any  disturbance  input  and  imcertain  parameter  variations. 
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Now  consider  the  design  of  a  controller  so  that  the  trajectory  beginning  from  any 
initial  condition  is  attracted  toward  the  switching  surface.  In  obtaining  a  control  law, 
differentiating  S(f)  along  the  trajectory  of  the  system  (equation  (8))  gives 


S  —  c  + 

=  Z  -  +  /^ 

=  -U  cos^^-^sin^w  +  cos^w-z^  +A£ 

=  -{U  cos  ^  +  sin  ^  w)q  +  cos  0a^2  )  +  -®2^c  +Ae, 


(16) 


where  ar2(^,d0  and  Bj  are  the  second  rows  of  vector  A  and  matrix  B,  respectively.  Since 
depth  control  is  to  be  executed  by  the  dorsal  fins,  equation  (16)  is  rewritten  in  the 
following  form: 


S  =  coseB2i[a{4,fp,mp,t)  +  Aa(^,di,fp,mp,t)  +  q'^ 
+  Fji  cos  cD^t  +  Fj2  sin cq,  r  +  J], 


(17) 


where  B^^d^  =  cos^q,/  +  F^^  sinuj  t .  Here  a  and  \\i  are  known  functions,  but  Aa,  the 
parameter  vector  q,  the  amplitudes  Fj,  and  F^i,  and  F21  are  unknown.  It  is  assumed  that 
the  sign  of  Bjx  is  known  that  |0|  <  0^  <  71  /  2 .  Without  loss  of  generality,  it  is  assumed 
that  F21  >  0.  The  known  functions  a  and  y/diXQ  computed  using  the  nominal  set  of  values 
of  various  parameters  of  the  system. 

The  camber  (Jof  the  dorsal  fin  is  continuously  varied  to  steer  any  trajectory 
toward  the  switching  surface.  Assuming  that  the  frequency  co^  of  the  surface  wave  is 
known,  a  control  law  is  now  chosen  as 


(18) 


-  sincoj  -  ^  -  K  sgn(S) , 

where  //  >  0,  77  and  are  estimates  of  tj  and  F^, ,  respectively,  and  F  is  a  constant  gain 
yet  to  be  determined.  Substituting  control  law  equation  (18)  into  equation  (17),  gives 

S  =  cos  9B2i[Aa[4,  d^,fp,mp,t)+  +  F^i  cos  coj 

(19) 

+  F^2  sin  a>gt  -  K  sgn  S  -  /jS], 


where  7  =  7  -  7,  and  F^,  =  F^,-  -  F^,- . 

Now,  adaptation  laws  for  ^5  Fdi »  and  gain  K  must  be  chosen  so  that  the  surface  S 
becomes  attractive  to  any  trajectory  of  the  system.  In  deriving  the  adaptation  law, 
consider  a  Lyapunov  function, 
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cos^)-'5'  +  rj\^  +  F,]  L,  +  Fj,  L,)/2, 


(20) 


where  Z,  is  any  positive  definitive  symmetric  matrix,  Zj  >  0  and  Zj  >  0.  The  derivative 
of  Vg  is  given  by 

=  S{Aa  +T]^y/  +  F^^  cos co^t  +  F^2  sin a>J  -  K sgn S) 

-  +  7  ^Zi7  +  •  (21) 

The  function  Fis  a  positive  definite  function  of  S,  rj,  F^j ,  F^2  since  |cos  9\  >  cos  0^  and 
Vg  (0)  =  0.  In  order  to  ensure  that  the  surface  F  =  0  is  attractive,  adaptation  laws  and  K  are 
chosen  so  that  satisfies  )^<0. 

In  view  of  equation  (21),  one  chooses  the  adaptation  laws  of  the  form 


fj=-ri  =  Z7’^mS, 

hi  =-  hi  =  L~2  S  cos  01 1,  (22) 

hi  =-  hi  =  Fz  S  sin  t, 
and  the  gain  K  is  chosen  to  satisfy 

K  =  kl^,d„fp,m^^  +  e,  (23) 

where  the  function  is  a  bound  on  the  uncertain  function  satisfying 

Zi  >  \Aah,  d^,fp,mp,  r)| .  (24) 

Substituting  adaptation  law  (22)  in  equation  (21)  now  yields 

V^<-s\S\- /LtS^  <Q.  (25) 


Since  <  0 ,  it  follows  that  S,  fj ,  and  F^,  are  bounded.  Furtheimore,  in  view  of  equation 
(25),  one  has 

00 

I  [ijS^  +  <  F(0)  -  F(oo)  <  00 ,  (26) 

0 
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which  implies  that  5  is  a  square  integrable  function.  Furthermore,  boundedness  of  S 
implies  from  equation  (13)  that  e,e  axe  bound.  Assuming  that  the  reference  trajectory 
,  and  are  bounded,  it  follows  from  boundedness  of  e  that  w  is  bounded  (in  view  of 
the  computation  for  i  in  equation  (7)).  Then  one  concludes  that  SQ)  -^0,  as  /  — >  oo , 
assuming  that  0,q  are  boimded.  This  implies  that  the  tracking  error  (z  -  yf)  ^  0  as  oo. 
This  completes  the  depth  control  system  design. 

The  control  law  (equation  (18))  includes  a  switching  function  that  essentially 
compensates  for  the  uncertain  function  Aa  and  the  adaptive  component  depending  on  fj 
compensates  the  linearly  parameterized  uncertain  function  q  y/.  For  countering  the 
wave  effect,  sinusoidal  components  of  frequency  0^ ,  which  are  functions  of  the 
parameters  ,  suffice.  It  is  shown  that  parameter  divergence  may  occur  often  in  the 
adaptive  system  in  the  presence  of  modeling  error  (Sastiy  and  Bodson^').  There  are 
several  ways  by  which  divergence  of  parameters  (7,/’^,  )  can  be  avoided.  Since  the 
upper  boimds  on  the  hydrodynamic  parameters  can  be  assumed  to  be  known,  a  projection 
method  can  be  used  to  modify  the  adaptation  law  (equation  (22)).  According  to  the 
projection  method,  the  estimates  P  and  are  set  to  their  limiting  values  whenever  the 
trajectory  tries  to  escape  its  permissible  range. 

Assuming  that  error  {f)  z*,  and  y^  ->•  0,  the  control  law  (equation  (18)) 

asymptotically  decouples  {6,q)  dynamies  from  the  remaining  variables.  Thus,  the 
residual  dynamics  of  the  system  essentially  describe  the  rotational  pitch  motion.  This 
residual  dynamics,  when  the  motion  is  constrained  so  that  the  error  y  =  0,  is  called 
the  zero-error  dynamics  (Slotine  and  Li’^).  For  satisfactory  performance  in  the  closed- 
loop  system,  the  state  variables  9  and  q  associated  with  zero-error  dynamics  must  be 
bounded.  In  the  next  section,  control  of  pitch  angle  using  flapping  foils  is  considered. 

Remark  1 :  In  the  derivation  of  the  depth  controller,  it  has  been  assumed  that  the 
frequency  &o  of  the  surface  wave  is  known.  However,  it  is  pointed  out  that  such  an 
assumption  is  not  essential  and  one  can  set 

Fdi=Fdi  =  ^>  (27) 

in  equations  (17)  and  (18)  for  control,  but  in  this  case  one  has  a  large  value  of 
satisfying  >  \Aa\.  This  requires  a  large  gain  k  and,  thus,  larger  magnitude  of  5 for 
control. 


Synthesis  of  the  discontinuous  control  law  may  lead  to  control  chattering,  which 
is  undesirable.  A  way  to  avoid  this  phenomenon  of  chattering  is  to  use  an  approximate 
but  continuous  control  law  instead  of  equation  (1 8).  This  can  be  done  easily  by  replacing 
the  sgn  function  in  equation  (18)  by  a  sat  function  where 


11 


(28) 


sat(5)  = 


{(S  /£i),  if\S\<£^ 

1,  ifiS>£’i 

-1,  ifS<-£^ 


where  £]  >  0  is  the  boundary  layer  thickness.  Implementation  of  the  approximate 
controller  may  lead  to  small  terminal  error,  but  this  error  tends  to  approach  zero  as  £^ 
tends  to  0. 


FLAPPING  FOIL  CONTROL  OF  PITCH  DYNAMICS 

In  this  section,  control  of  rotational  pitch  dynamics  (zero  error  dynamics)  is 
considered.  First,  a  discrete-time  linear  model  for  pitch  control  is  obtained. 


DISCRETE-TIME  PITCH  DYNAMICS 

Since  the  sliding  mode  controller  asymptotically  controls  z  to  z*,  the  zero  error 
dynamics  is  obtained  from  equation  (1)  by  setting  e  =  z-  =  z  =  0.  Also,  when 

e(t)  =  0,  e(t)  =  z-  =  f  =  0,  one  has  for  small  0 

w  =  U0.  nc 


It  is  assumed  that  the  two  foils  oscillate  with  identical  frequency  coj .  The 
maximum  travel  Af  of  each  foil-tip  is  independently  controlled  periodically  at  the  interval 
of  Tp{=  This  way  the  Strouhal  numbers  S',,  and  5,2  of  the  two  foils  are 

independently  controlled.  The  moments,  7Wp,(5,„cy^),  and  forces,  /p,(5,„cy^)  (/  =  1,2), 
generated  by  the  flapping  foils  are  nonlinear  fimctions  of  the  Strouhal  numbers.  Since  coj 
is  a  constant,  expanding  fp{s,)  and  ^^,(5,^  in  the  Taylor  series  about  5,,  =  5,2  =  5*,  a 
constant,  and  neglecting  higher  order  terms  gives 


-®33'^p/(‘5';()+-^32/p/  **  -^33 

.  ^1.- 


{coft  +  a^ 


!5,, 


+  B 


32 


cSti  cSti 


Abi,Q)S,i,  i  =  l,2. 


(30) 


where  5„  =  5„  -S*. 

Next,  pitch  angle  must  be  regulated  to  0*,  a  constant.  Using  equations  (21),  (22), 
(25),  and  (29),  the  pitch  dynamics  about  (0*,q*  =  O)  obtained  from  (7)  are  given  by 
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=  '^6  ^5^  +  COS  e *  -Xgb  sin  e  *)  Jl 

(31) 

+  0  ^22  "^tl  +  -02(^^) 

where  for  small  6 

£>2  =  (ij  +  ciqXQQ  cos  +a8  +  53j^  +  a^U9*  +a-jZQ^  sin  9*. 

The  system  (31)  can  be  written  as 

X  A  ApX  +  6, [&, ,  iS„  +  ^22  S,2  +  A (^)] ’  (22) 

where 

7  «cs  =”«*)] ,  and 

*,=[1,0]". 

The  solution  of  equation  (24)  is  given 

xQ)  =  J  +  j  +  b22ir)S,2iT}  +  A(r)]c/r .(33) 

^0 

Since  the  control  input  5*,,  is  to  be  implemented  as  a  piece-wise  constant  function 
changing  at  the  interval  Tp,  a  discrete-time  model  is  obtained  from  equation  (33)  of  the 
form 

x(k  + 1)  =  A,x(k)  +  B,Sf  (k)  +  A  (^)  >  (34) 

where  (k  + 1)  denotes  (k  +  DT^,  S'^ft)  =  S((k)  =  [5'^j'(A:),S',2(^)]^  for  ts^kTpik  + 1)^), 
and 


(35) 
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Let  4  =  [a^y),  4  =  =  [b^.^  for  i,j  =  1,2,  and  D^k)  =  .  Note  that  B, 

is  a  2x2  constant  matrix  since  integration  in  equation  (35)  is  performed  over  one  period 
Tp  and  (Of  =  InTp  ,  but  D^ik)  depends  on  kTp  due  to  the  fact  that  C0f^%\  that  is,  the 
flapping  frequency  differs  from  the  frequency  of  the  wave. 


AUTOREGRESSIVE  MOVING  AVERAGE  MODEL 

Next,  a  discrete  adaptive  predictive  control  technique  is  used  for  pitch  control.^® 
For  this,  an  expression  for  the  predicted  value  of  0(A:)  is  obtained  and  the  advance 
operator  is  introduced  and  defined  as 


q^zXk)=zXk  +  \)  (36) 

for  any  discrete  signal  zj^k).  Using  equation  (34)  gives 

qa'qik')  =  a^^^qik)  +  a^-^2^(,k)  +  B^^Sf(.k)  + D^^ik)  (37) 

q^e  ik)  =  a^2\R^k)  +  a^22^a)  +  B^2^fik)  +  D^2^k).  (38) 

Equation  (37)  gives 

q~^qik)  =  qa^{a^uQ^k')  +  a^^2^ik)  +  B^^Stik')+D^^{.k)].  (39) 

Operating  by  q^^  equation  (38)  gives 

eik)  =  q~\a^2\^{k)  +  a^22^{k)+B^2SM)  +  D^2^k)].  (40) 


Substituting  for  q^qik)  from  equation  (39)  into  equation  (40)  gives 
0(^)  =  a^2\<la\<^c\\^^k)  +  0^12  to  +  B^^Sfik)  +  I>^i(^)] 

+  ^;'k22to  +  B,2St(.k')  +  D,2ik')].  (41) 

Using  equation  (40),  one  obtains 

q~^q  ik)  =  [q-^9  (k)  -  qf  {0^22^ +  ^^2-^/ (k)  +  (*)}]/«c2l .  (42) 

which  is  substituted  into  equation  (41)  to  yield 
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9  ik)  =  ,  [q-j9ik)  -  {a, ^-^9  ik)  +  bJ,  (k)  +  D,2  (A:)}] 

+  ^c2\^a  ^  {^c\2^  ^A:)  +  i.k)+  Z)^|  (A:)} 

+  bc220  ik)  +  B,2S,  ik)  +  D,2  (^)]  • 

Rearranging  terms  in  equation  (43),  one  has 

[l+(-«cll  -«c22ka’  +(«cll«c22  -«c21«cl2)^a^p(A^) 

=  Ha '  [^c2  +  i^c2l^c\  ~  ^cl  1  ^c2 ha  ^  ]‘^i- (A^) 

+H~a\D^  (A^)  +  «c21?a ’^cl(A^)  -  «cl \Ha^Dc2  (A^)]  W 

or 

{l  +  afyq~^ +af2qa^)9ik)  =  q-\Bf^  +  Bf2qZ^)Stik)  +  q-^af^ik),  (45) 

where 


^/1  ~  ^cll  ^c22 

^/2  ~  ^cll^c22  ^^cll^cU 

=  B,,  (46) 

^f2  ~  ^c21-®cl  ~^cU^c2 

a^jik)  =  D^^ik)  +  a^2iHa'D,^ik)-a^uHa'D,2ik). 

The  discrete-time  model  of  equation  (45)  is  called  an  autoregressive  moving 
average  (ARMA)  model.  The  ARMA  model  can  be  expressed  in  an  alternative  predictor 
form  using  equation  (46)  rewritten  as 

9  ik  +  !)  =  {-  aj-^  -  aj-2qa^)9ik)  +  {^Bj-i  +  Bj-2qa^)S(ik)  +  a^^ik).  (47) 

This  is  a  useful  representation  of  the  pitch  dynamics.  It  is  assumed  that  the 
parameters  Oft,  Bft,  and  the  signal  af^K)  are  imknown.  For  the  regulation  of  9ik),  one  can 
design  predictive  control  laws  if  the  estimates  of  the  unknown  parameters  and  afj{k)  are 
known. 


For  the  derivation  of  a  control  law,  it  is  assumed  that 

af^ik  +  \)^afdik).  (48) 

Note  that  if  the  wave  frequency  cOo  is  equal  to  the  frequency  of  flapping  and  if 
either  5  is  small  or  Rji  »  0,  then  Of^k  +1)  =  aj^K)  for  all  k.  In  practice,  it  has  been  found 
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that  the  predictive  control  technique  works  well  even  when  parameters  vary  slowly  and 
the  condition  of  equation  (48)  is  violated. 


Under  the  assumption  of  equation  (48),  subtracting  qj9{k  +  \)  from  (47)  gives 

+ 1)  =  [-  “/i  +  (“/I  -  ]«(*■) 

+  [^/l  +(5/2  --S/l)?;'  +  (49) 

where 

^o  =  -^f\^^=af^-af2,V2=aj2,Po  =  Bfi,l\= 

/8(9»'’)=a+9;V(9;'). 

^'(«a')  =  ^+/%9j‘- 


=  -B 


J2-. 


(50) 


ADAPTIVE  PITCH  ANGLE  CONTROL 

Assuming  that  the  parameters  of  equation  (49)  are  known,  now  a  weighted  one- 
step  ahead  pitch  control  law  is  obtained.  For  this  a  suitable  performance  index  of  the 
form 


J(k + 1) = ^[0(k+\)-e;{k + 1)]^ + i/i  Js,(*-)f  (51) 

if. 

i^chosen,  where  and  0^  (k)  is  a  suitable  reference  trajectory  to  be  followed  by 

6  (k) .  Note  if  6^  {k)  0,  then ^(k)  9* .  By  the  choice  of  a  suitable  value  of  a 

compromise  between  bringing  9{k  +  \)  to  0*  {k  -i- 1)  and  the  amount  of  control  effort 
expended  is  achieved. 

Substituting  9(Jc  -t  1)  from  (49)  and  (51)  and  for  minimizing  /  differentiating  with 
respect  to  S^ik)  gives 

ik)  +  I3,s,{k)  +  J3'(q-%{k  - 1) -  9; (k  + 1)]  +  l^S,(k)  =  0.  (52) 

Solving  (52)  gives  the  control  law 

S,(k)  =  {Z,I  +  fil/3j'g[-v{q;<)S(k)-p‘{q:')S,(k-l)  +  e:{k  +  l)].  (53) 

Notice  that  the  Strouhal  number  at  t^  instant  kTp  depends  on  the  present  and  past  values 
of  ^and  the  past  values  of  input  St,  St . 
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Since  ^,(k)  e[0,  Sti^]  where  5,,^  is  the  same  maximum  allowed  value  of  S(j, 
control  input  S(i(k)  given  in  (53)  must  be  modified  to  meet  the  practical  constraint  on  its 
magnitude. 

A  modified  control  law  for  pitch  control  is 


S,(k) = 


SuW, 

0, 

.^tim  ’ 


if0<5;,(/:)<5,,„ 

if  S'tiik)  <  0 

if  S',(k)  >  5,,, 


(54) 


where  S'/  =  (S/j  denotes  the  expression  in  the  right-hand  side  in  equation  (53). 


PARAMETER  ESTIMATION 

For  synthesizing  the  control  law,  the  parameters  in  equation  (49)  must  be  known. 
A  practical  solution  to  this  problem  is  to  obtain  an  estimate  of  these  unknown  parameters 
using  an  appropriate  parameter  identification  technique.  There  are  several  kinds  of 
algorithms  based  on  the  projection  and  the  least  square  methods^”  that  can  be  used  to 
obtain  the  estimates  of  these  unknown  parameters  ,  and  in  equation  (49). 
Equation  (49)  can  be  written  as 

9{k  +  \)  =  f{k)p,,  (55) 


where 


=  [(l  qf)e  (i),(l  9;’  o:^)sJ (t)] 


Using  a  simple  projection  algorithm  for  parameter  estimation,  the  estimate 
of  Pg  is  obtained  using  an  update  law  given  by^° 

A(t)  =  - 1)  + - (*>  - ')] 

Cl  +(P  (a:  -  1)^(a:  - 1) 

0  <  a(k)  <  2  (56) 

C]  >  0. 


Define 

l^(<la^)=Oo  +  l\qa^  +02qf 

Hq~Y)=A+AqY- 


(57) 
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Then  the  adaptive  control  law  for  pitch  angle  control  is  given  by 


S,{k)  =  [M  +  \-v{ql^)0{k)-P'{qJ%{k-\)  +  el{k  +  \)].  (58) 

This  completes  the  design  of  flapping  foil  controller. 

Now  the  adaptation  law  for  adjusting  the  maximum  travel  of  the  tips  of  the  two 
foils  is  easily  computed  using  the  definition  of  the  Strouhal  number  and  required 
adaptation  scheme  is  given  by 


Ai{k  +  \) 


USti(k) 
(ui y /  IfT  j 


where  = 


The  complete  closed-loop  system  is  shown  in  figure  2. 


(59) 


CONCLUSIONS 

A  theoretical  study  for  the  dive  plane  control  system  design  for  biologically 
inspired  maneuvering  of  low  speed,  small  undersea  vehicles  using  dorsal  and  caudal 
fm-like  control  surfaces  was  considered.  Normal  force  produced  by  the  dorsal  fin  was 
used  to  control  the  depth  of  the  vehicle  and  two  flapping  foils  were  used  for  the  pitch 
angle  control.  An  adaptive  sliding  mode  control  law  was  derived  for  the  reference  depth 
trajectory  tracking.  For  the  design  of  this  control,  a  nonlinear  vehicle  model  was 
considered  for  which  the  system  parameters  were  assumed  to  be  unknown,  and  it  was 
assumed  that  sinusoidal  disturbance  force  and  moment  are  acting  on  the  vehicle  caused 
by  surface  waves.  In  the  closed-loop  system,  including  the  sliding  mode  controller,  depth 
control  was  accomplished  and  rotational  pitch  dynamics  were  asymptotically  decoupled. 

For  the  decoupled  pitch  dynamics,  assuming  that  the  pitch  angle  perturbations 
were  small,  a  linear  deterministic  autoregressive  model  was  derived.  For  the  pitch  angle 
control,  the  Strouhal  numbers  were  chosen  as  key  input  variables.  The  Strouhal  numbers 
of  the  two  foils  were  periodically  changed  (at  intervals  of  the  time  period  of  oscillations 
of  the  foils  by  altering  the  maximum  tip  travel).  Both  foils  were  oscillating  at  the  same 
frequency.  Using  projection  algorithms,  the  parameters  of  the  pitch  dynamics  were 
identified.  These  estimated  parameters  were  used  to  design  an  adaptive  predictive  control 
system.  The  adaptive  predictive  controller  accomplished  regulation  of  the  pitch  angle. 
Thus,  in  the  complete  closed-loop  system,  including  the  adaptive  sliding  mode  and 
adaptive  predictive  controllers,  dive  plane  control  of  the  underwater  vehicle  can  be 
accomplished  in  the  presence  of  large  parameter  uncertainty  and  sea  surface  waves. 
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